#include <BLEDevice.h>
#include <Esp.h>

static BLEClient *pClient;
const BLEUUID serviceUUID("ebe0ccb0-7a0a-4b0c-8a1a-6ff2997da3a6");
const BLEUUID charUUID("ebe0ccc1-7a0a-4b0c-8a1a-6ff2997da3a6");
static BLERemoteService *pService;
static BLERemoteCharacteristic *pCharacteristic;

//a simple connect function, after connecting, to operate one servcice
bool connectAndSetNotify(BLEAddress address)
{
	if (pClient->connect(address) == true)
	{
		Serial.printf("signal strength %d \n", pClient->getRssi());

		pService = pClient->getService(serviceUUID);
		if (pService == nullptr)
		{
			Serial.print("connection broken: fail to get service");
			if (pClient->isConnected())
				pClient->disconnect();
			return false;
		}
		pCharacteristic = pService->getCharacteristic(charUUID);
		if (pCharacteristic == nullptr)
		{
			Serial.print("connection broken: fail to get characteristic");
			if (pClient->isConnected())
				pClient->disconnect();
			return false;
		}
		else
		{
			pCharacteristic->registerForNotify([](BLERemoteCharacteristic *pBLERemoteCharacteristic_THB, uint8_t *pData, size_t length, bool isNotify) {});
			return true;
		}
	}
	else
	{
		Serial.println("fail to connect");
		return false;
	}
}

void setup()
{
	Serial.begin(115200);
	BLEDevice::init("ESP32");
	pClient = BLEDevice::createClient();
}

void loop()
{
	BLEAddress addressAvailable("a4:c1:38:00:00:00");
	BLEAddress addressNotAvailable("a4:c1:38:00:00:01");
	//the first device MUST be connectable and the second device MUST be not connectable
	Serial.println("connecting to an available device");
	connectAndSetNotify(addressAvailable);
	pCharacteristic->registerForNotify(NULL);
	pClient->disconnect();

	//wait for disconnect
	delay(2000);
	Serial.println("connecting to a not available device");
	connectAndSetNotify(addressNotAvailable);
	Serial.println("!!can not reach!!");
	delay(10 * 1000);
}